TITLE OF THE INVENTION 

TEACHING MODEL GENERATING DEVICE 

BACKGROUND OF THE INVENTION 

1. Field of the Invention: 

This invention relates to a device for generating a teaching model applied 
to a method of detecting the position and posture of an object through pattern 
matching. More particularly, the present invention relates to a device for 
generating a teaching model for making it possible to detect an object regardless 
of three-dimensional variations in position and posture of the object for 
detection* 

2. Description of the Prior Art: 

There is provided a weU-known method and device for detecting the 
position and posture of an object set on a plane by storing a two-dimensional 
image of the object for detection as a teaching model, prior to pattem matching 
of the teaching model with image data produced by means of taking an image of 
the object with an image pickup means such as a camera. The above method 
and device for detecting the object is applied to conveyance or like jobs of 
machine parts and articles or like workpieces grasped with a robot to a 
predetermined position in an automatic mode. 

However, picking-out of an individual workpiece from a pile of disordered 

same-shaped workpieces or a set of same-shaped workpieces housed within a 

predetermined range ui any three-dimensionaUy different position and posture 

is not suited for the robot, and therefore, requires manual operation. In the 

case of allowii^ the robot to pick out such an individual workpiece, there is the 
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need for the manual operation of picking out the workpieces one by one from the 
pile of disordered workpieces for reoriented alignment such that the robot may 
pick out the individual workpiece directly. 

For allowing the robot to grasp each workpiece for picking out from a 
large number of same-shaped workpieces piled up disorderly or housed within 
the predetermined range in any three-dimensionally different position and 
posture, it is necessary for the robot to recognize the position and posture 
(direction) of eadi of the above workpieces. 

In this connection, a device for detecting the three-dimensional position 
and posture (direction) of the individual workpiece among the workpieces has 
been developed. This device performs the following operations. 

(1) lb produce image data in advance by taking an image of one of same-shaped 
wor]q)ieces for detection with a camera from different directions 

(2) lb store a plurality of teaching-models based on the produced image data, 
together with the relative position and posture of each teaching model to the 
workpiece 

(3) Tb select a teaching model of a high matching value by carrying out pattern 
matching of each teaching model with image data produced by taMng an image 
of the piled same-shaped workpieces with the camera 

(4) For this selected teaching model, to detect the position and posture (direction) 
of the target workpiece for detection to the selected teaching model on the basis 
of the relative position and posture of each teaching model to the workpiece, 
stored in the above operation (2). 

The above device requires a plurality of teaching models generated by 
taking the image of the workpiece from the plurality of directions as shown in 
the above operation (1). 
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OBJECTS AND SUMMARY OF THE INVENTEON 

It is an object of the present invention to provide a device for generating a 
teaching model applied to an image processing device fcr detecting the three- 
dimensional position and posture of an object 

The present iavention relates to a teaching model generating device for 
image processing, in which an object or an article having the same shape as that 
of the object is selected as a reference object, and three-dimensional position 
and/or posture of the object is recognized by carrying out matching processing of 
a plurality of teaching models, which were generated and stored in advance on 
the basis of the respective image data produced by taking the image of the 
reference object from a plurality of directions, with the image data including the 
object. 

According to the first mode of the invention, one of the reference object 
and the image pickup means is fixed in place, while the other is fixed to a 
movable part of a robot or is grasped with a hand of the robot, and the robot is 
operated for positioning to a plurality of image picktq) positions where direction 
of the optical axis of the image pickup means with respect to the reference object 
is different fiom one another respecti.vely, so that the image data respectively 
obtained at each of the image pickup positions is stored as a teaching model 

According to the second mode of the invention, the reference object is fixed 
to a movable part of a first robot or is grasped with a hand of the first robot, and 
an image pickup means is fixed to a movable part a second robot of is grasped 
with a hand of the second robot, and any one of or both of these first and second 
robots is operated for positioning to a plurality of image pickup positions where 
direction of the optical axis of the image pickup means with respect to the 




reference object is different firom one another respectively, so that the image data 
respectively obtained at each of said image pickup positions is stored as a 
teaching model 

Preferably, the teaching model is a part of the image data of the reference 

object. 

Preferably, the teaching model is composed of data obtained by 
performing a image processing on the image data of the reference object. 

Preferably, the teachii^ model is generated for every direction in which 
the image pickup means took the image of the reference object and the teaching 
model is stored in association with the information on the direction. 

Preferably, the image pickup means is a camera. 

Preferably, the image pickup means is a three dimensional visual sensor 
whose image pickup means measures the distance between the image pickup 
means and a plurality of points on the object. 

According to the present invention, the robot may be used to simply 
generate teaching models which are applied to an image processing device or the 
like for detecting the position and posture of an object through identification of 
the object regardless of three -dimensional variation in position and posture of 
the object. 

BRIEF DESGRDPTTON OF THE DRAWINGS 

The foregoing and other objects and features of the invention will become 
apparent &om -the following description of preferred embodiments of the 
invention with reference to the accompanjring drawings, in which: 

Fig. 1 is view for explaining the outline of a first embodiment according 
to the present invention; 
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Fig. 2 is a view for explaining the outline of a second embodiment 
according to the present invention; 

Fig. 3 is a view for explaining the outline of a third embodiment 
according to the present invention; 

Fig. 4 is a view showing teaching models in each of the above 
embodiments; 

Fig. 5 is a block diagram showing an essential part of a robot controller in 
each of the above embodiments; 

Fig. 6 is a block diagram showing an essential part of an image 
processing device in each of the above embodiments; 

Fig. 7 is a flow chart showing the procedure to generate teaching models 
in the first embodiment; 

Fig. 8 is a flow chart showing the procedure to generate teaching models 
in the second embodiment: 

Fig. 9 is a flow chart showing the procedure to generate teaching models 

in the third embodiment; 

Fig. 10 is a flow chart showing the procedure of picking job: 

Fig. 11 is a view for explaining the operation of a visual sensor for 

measurement of distance data for use in the embodiments according to the 

present invention; 

Fig. 12 is a view for explaining two-dimensional array data composed of 
distance data as image data produced by the above visual sensor for 
measurement of distance data; and 

Fig. 13 is a flow chart showing the procedure to produce two-dimensional 
array data as the above image data. 
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DETAILED DESCRIFnON OF THE PREFERRED 
EMBODIMENTS 

A teaching model generating device configured by a robot system will be 
described below as an embodiment according to the present invention. 

Fig. 1 is a schematic view showing the first embodiment for generation of 
a teaching model according to the present invention. As shown in Fig. 1, a 
workpiece W is fixed in place to take an image of the workpiece W from a 
plurality of directions with an image pickup device 20 grasped with a hand of a 
robot RB (or fixed to a movable part of the robot RB). A teaching model of an 
object (the workpiece W) is generated on the basis of image data produced by 
taking the image of the workpiece. For instance, four teaching models are 
respectively generated on the basis of four image data produced by taking the 
image of the workpiece W fix)m four directions as shown in Fig. 4. 

Fig. 5 is a block diagram showing an essential part of a controller of the 
robot RB in the present embodiment, and this controller has the same 
configuration as a robot controller in the prior art. 

As shown in Fig. 5, connected to a bias des^nated by reference numeral 8 

are a main processor (which will be hereinafter simply referred to as a processor) 

1, a memory 2 composed of a RAM, a ROM and a non-volatile memory 

(EEPROM or the like), a teaching operation panel interfece 3, an external device 

interfece 6, a commimication interfece 7 for communication with an image 

processing device and a servo control unit 5. A teaching operation panel 4 is 

connected to the teaching operation panel interface 3. 

A system program for supporting basic functions of the robot and the 

robot controUer is stored in the ROM of the memory 2. An operation program 

and its related set data of the robot taught according to an application are stored 
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in the non-volatile memory of the memory 2. The RAM of the memory 2 is 
used for a storage area for temporary storage of data in various processing 
executed by the processor 1. 

The servo control unit 5 is equipped with servo controllers Sal to San (n 
being a nimiber resulting from adding the number of movable axes of a tool 
mounted to a robot wrist to the total number of robot axes). Each servo 
controller is composed of a processor, a ROM and a RAM or the like to perform 
loop control of position and speed of a servo motor for driving each axis and also 
loop control of current. This servo controller constitutes a digital servo 
controller performing loop control of position, speed and current in software. 

Output from the servo controllers Sal to San is provided throv^h servo 
amplifiers Sbl to Sbn to axis servo motors Ml to Mn to control the drive of these 
servo motors. Incidentally, although not shown, a position/speed detector is 
moxmted to each of the servo motors Ml to Mn to detect the position and speed 
of each servo motoi; and the detected position and speed are allowed to be fed 
back to the servo controllers Sal to San. 

The input/output interfoce 6 is cormected to sensors moxmted to the robot, 
together with actuators and sensors of the peripheral equipment, 

Fig. 6 is a block diagram showing an image processing device 30 

coimected to an interfoce of the robot controller. The image processing device 

30 has a processor 31, and the processor 31 is coimected through a bus 40 to a 

ROM 32 for storage of a system program or the like executed by the processor 31, 

an image processor 33, an image pickup device interfoce 34 connected to the 

image pickup device, an MDI 35 with display such as a CRT and a liquid crystal 

display for input and output of various commands and data, an image memory 

36, a non-volatile memory 37, a RAM 38 for temporary storage and so on of data 
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and a communication interfece 39 connected to the robot controller 10. 

^-|An image produced by the image pickup device 20 is stored in the image 
memory 26. The image processor 33 conducts processing of the ims^e stored in 
the img^e memory acoording\to a command from the processor 31 to recognize 
the object. The image processing device 30 is similar in configuration and 
fimction to an image processing advice in the prior art. However, according to 
the present invention, the image processing device 30 is characterized in that 
teaching models (described later) ari stored in the non-volatile memory 37, and 
pattern matching is carried out by lising the stored teaching models, for the 
image data of the pile of workpieces plmographed by the image pickup device 
20 to obtain three-dimensional position anaj)osture of the workpiece. 

As win be described later, the image pickup device 20 is to produce the 
im^e data, and a CCD camera for producing a two-dimensional image or a 
visual sensor permitting the measurement of distance data is available for the 
image pickup device 20. The CCD camera produces the image data ficom the 
two-dimensional image according to a conventionally known method, while the 
visual sensor for measurement of distance data is to produce, as image data, 
two-dimensional array data composed of distance data representing the distance 
between the sensor and the object. Since a three-dimensional visual sensor of 
spotlight scan type or the like disclosed in Japanese Patent Application Laid- 
open No. 7-270137 is weU known as the visual sensor for measurement of 
distance data, a description wiH now be given of the three-dimensional visual 
sensor briefly. 

The three-dimensional visual sensor is adapted for measuring the 

position of a beam spot irradiated onto the object with two scanners in arbitrary 

directions (X- and Y-directions) by using a detector (PSD) of position detection 
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type. Thus, this three-dimensional visual sensor is effective in finding the 
three-dimensional position of the object irradiated with the beam by calculation 
on the basis of mirror deflection angles 0 x, By of two scanners together with a 
Hght detecting poation on the PSD. 

A description will now be simply given of a method of producing, as 
image data, two-dimensional array data composed of distance data with this 
three-dimensional visual sensor with reference to Figs. 11 to 13. 

The range of scan over the object (the range of measurement) is 
determined in advance, and in this state, the three-dimensional visual sensor 
makes measurement of the three-dimensional position in each point on the X-Y 
plane in the predetermined i^nge of scan to find the distance Z (i, j) in each point 
(i, j) between the sensor and the point of the beam irradiated onto the object in 
the manner of making a scan over the object ia sequence of points (1, 1) to (1, n), 
(2, 1) to (2, n), . . . (m, 1) to (m, n) on ihe above X-Y plane under discrete control of 
the mirror deflection angles 0 x, 0 y of the scanners, as shown in Fig. 11. 
Then, this distance data Z (i, j) is stored in the RAM 38 of the image processing 
device 30. 

With the above operation, the three-dimensional visual sensor may 
produce, as image data, the two-dimensional array data composed of the 
distance data Z (i, j) between the sensor and the point of the beam irradiated 
onto the object, as shown in Fig. 12. 

Fig. 13 is a flow chart showing the processing performed by the processor " 
3 1 of the image processing device 30 to produce the image data. " 

Firstly, indexes i, j are set at "1" (Step 500) to issue a command to 

irradiate to the sensor 20, together with commanded mirror deflection angles 6 

X, 0 y corresponding to the start points yl, xl (the point (1, 1) in Fig. 11) in the 
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predetermined range of measurement (Steps 501 to 503). The sensor 20 
irradiates optical beams after the miTTors are set at these deflection angles. 
Then, the sensor 20 outputs a signal produced by ihe PSD to the unage 
processing device 30. 

The processor 31 of the image processus device 30 calculates the 
position of a beam spot formed oh the object on the basis of the signal from the 
PSD and the commanded mirror deflection angles Ox, 0 y to find the distance 
Z (i, j) between the sensor and the beam spot position, and then stores the 
distance data in the RAM 28 as two-dimensional array data [i, j\ (Steps 504 and 
505). Instead of the processor 31, the sensor 20 may be appHed to calculation of 
finding the position of the beam spot formed on the object and also that of 
finding the distance Z (i, j) on the basis of the above beam spot position. 

Subsequently, the processor 31 increments the index i by "1" to increase 
the mirror deflection angle 0 x in X*axial scannir^ by a predetermined amount 
A X (Steps 506, 507), and decides whether or not the index i exceeds a set value n 
(Step 508). If not exceeding, the processing is returned to Step 503 to find the 
distance Z (i, j) in the ne3ct point by repeating the processing in Steps 503 to 508. 
Subsequently, the processing in Steps 503 to 508 is executed for fibnding and 
storing the distance Z (i, j) at each point from (1, 1) to (1, n) in Fig. 11 until the 
index i exceeds the set value n. 

When it is decided in Step 508 that the index i exceeds the set value n, 

the processor 31 sets the index i at "1", and increments the index j by "1" to 

increase the mirror deflection angle 0 y in Y-axial scanning by a predetermined 

amount Ay (Steps 509 to 511). Subsequently, the processor 31 decides 

whether or not the index j exceeds a set value m (Step 512). If not exceedir^, 

the processing is. returned to Step 502 to repeat the processing in Steps 502 to 
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512. 

As described above, the processing in Steps 502 to 512 is performed 
repeatedly \mtil the index j exceeds the set value m. The measurement of aU 
the points in the range of measurement (the range of scan) shown in Pig. 11 is 
considered to be finished as of the time when the index j exceeds the set value m. 
Then, the distance data Z (1, 1) to Z (m, n) serving as the two-dimensional array 
data is stored in the RAM 28, resulting in the completion of the processing to 
produce the image data. 

The above processii^ is applied to produce the two-dimensional array 
data as the image data with the visual sensor for measurement of distance data. 

The two-dimensional array data produced as described above may be 
used as the image data to generate teaching models. However, for 
simplification, a description wiU now be given of the procedure to generate 
teaching models on the basis of the knage data produced by taking in the image 
of the object with the CCD camera 20 serving as an image pickup device for 
taking in image data. 

A description will be given of the procedure to generate teaching models 
by iising the teaching model generating device according to the present 
embodiment configured by the robot controller 10 and the image processing 
device 30 with reference to the flow chart shown in Fig. 7. 

An operator sets a work coordinate system as to the workpiece fixed in 

place in the robot controller 10 through the teaching operation panel 4. The 

work coordinate system is stored in the robot controller (Step 100). In this 

place, the meaning of setting of the work coordinate system is that a coordinate 

transformation matrix of the work coordinate system as seen fixjm a world 

coordinate system provided in the robot is set in the robot controller. 
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Then, calibration of the camera mounted to the robot wrist is performed 
and camera mounting position and posture based on the center of the flange 
surface of the robot wrist is set in the robot control device 10. As a result, a 
camera coordinate system is set in the robot (Step 101). 

Then, for specifyir^ the first (0^) position and posture of the camera 
moimted to the end of the robot wrist for the image-taking operation with 
respect to the workpiece W and subsequent positions and postures, a tumir^ 
axis and a turning angle for turning the camera firom the first position and 
posture is set, and also the number N of positions and postures which the 
camera assumes for the image-taking operation is set (Step 103). 

For instance, four teaching models are generated on the basis of four 
image data produced by taking the image of the workpiece W firam four 
directions (N=4) as shown in Fig. 4. 

Fig. 4(a) shows a first teaching model generated throi:^h the image- 
taking operation with the camera in the 0^ position and posture. The first 
teaching model is generated on the basis of the image data produced by taking 
the image of the top of the workpiece W with the camera firam the Z-axis 
direction of the world coordinate system. 

Subsequently, the robot is operated to turn the camera by a certain angle 

about an axis, which passes through a specific point (an origin of the work 

coordinate system) on the workpiece W and is perpendicular to the center axis of 

the camera, to the first position and posture for the image-taking operation. 

InddentaUy, when the Z-axis of the world coordinate system is set to be parallel 

to the center axis of the camera in the first (0^) position and posture, the first 

position and posture next to the 0^ position and posture for the image-taking 

operation assume to be the position and posture provided by turning the camera 
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by a certain ai^le (for instance, 30 degrees) about an axis parallel to the axis (for 
instance, the X-axis) perpendicular to the Z-axial direction as shown in Fig. 4(b). 
Then, the second teachii^ model is generated on the basis of the image data (see 
Fig. 4(b)) produced by taking the image of the workpiece W with the camera in 
the above first position and posture. 

Thereafter, in the same way, the camera is caused to turn by 60 and 90 
degrees respectively &om the position shown in Fig. 4(a) about the axis, which 
passes through the specific point on the workpiece and is parallel to the X-axis, 
to the second and third positions and postures for the image-taking operation to 
take the image of the workpiece W respectively. Then, the third and fourth 
teaching models are generated on the basis of the image data (see Figs. 4(c) and 
4(d)) obtained fix»m the images the camera took at the respective positions and 
postures. 

In this place, a description will be given of one example of generating four 
teaching models in the above manner with respect to the workpiece servii^ as 
the object and application of these models. Incidentally, in the above 
embodiment, camera is caused to turn by 0, 30, 60 and 90 degrees about the 
workpiece serving as the object to generate four teaching models by taking the 
image of the workpiece with the camera firam the respective positions. 
Alternatively, if the txmiing angle of the robot to turn the camera is set at a 
smaller pitch for generation of more teaching models, it is possible to detect the 
three-dimensional position and posture of the workpiece with higher accuracy. 

As described above, the position and posture of the robot where the first 

(0^) image-taking operation is performed with the camera 20 mounted to the 

end of the robot wrist are taught together with the axis serving as the center 

axis of turning and the turning angle, and the nimiber N of positions and 
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postures for the image-taking operation is set. For easy understandii^, it is 
assumed that the position in which the center axis of the camera is parallel to 
the Z-axis of the world coordinate system and which has the same coordinate 
values of the X- and Y-axes, other than the Z-axis, on the world coordinate 
system as those of the workpiece W put in predetermined position and posture is 
taught as the position and posture for generating the 0^ teaching modeL 
Further, the positions turned by 30, 60 and 90 degrees about the axis, which 
passes through the position of the workpiece W and is parallel to the X-axis of 
the world coordinate system, are set as the first, second and third positions and 
postures for the image-taking operation. It is also assumed that the nimiber N 
of positions for the image-taking operation is set at "4". 

When a command to generate the teaching model is supplied through 
the teaching operation panel 4, the processor 1 of the robot controller 10 
niitiali2;es a counter M for counting the image-taking times to "ff' (Step 103), and 
outputs a command to take the image with the camera to the image processing 
device 30 after operating the robot to move the camera to the Mth (=0) position 
and posture (Step 104). The image processing device 30, in response to the 
above command, causes the camera to take the image of the workpiece W and 
stores the image data in the image memory 36. In addition to the above 
operation, the image processing device 30 generates the Mth teaching model on 
the basis of the image data and stores the generated Mth teaching model in the 
non-volatile memory 37 (Step 105), 

Further, the image processing device 30 calculates the position and 

posture of the work coordinate system as a coordinate transformation matrix as 

seen fix)m the camera coordinate system to find the relative position and posture 

of the camera to the workpiece, and then stores the found relative position and 
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posture in the non-volatile memory 37 as the relative position and posture of the 
Mth teaching model and outputs a data acquisition signal to the robot controller 
(Step 106), For instance, the above relative position and posture are stored in 
the form of [xO, yO, zO, a 0, j3 0, y 0,] c as the position and posture of the 
camera coordinate i^stem, where a , jS and y represent the turning angles 
about the X-, Y- and Z-axes, respectively, and "C" represents the camera 
coordinate system. 

Subsequentiy, the processor 1 of the robot controller 10 increments the 
counter M by "1" in response to the data acquisition signal (Step 107), and 
decides whether or not the value of the counter M is smaller than the set value 
N (=4) (Step 108). When the counter value is smaller than the set value, the 
processing is returned to Step 104 to move the robot to the Mth position and 
posture. That is, in the above embodiment shown in Fig. 4, the cam is 
caused to turn by 30 degrees about the axis, which passes through the position 
of the workpiece and is parallel to the X-axis of the world coordinate system, to 
store the teaching model and the relative position and posture of the camera to 
the workpiece at that time. 

In the following operation, the processing in Steps 104 to 108 is executed 

for storing the generated teaching model and the relative position and posture of 

the camera to the workpiece in the non-volatile memory imtil the value of the 

counter M reaches the set value N (=4). In the above example, the teaching 

models to be stored are those produced from the image of Figs. 4(a) to 4(d). 

For the above four teaching models, the relative position and posture of the 

camera to the worlqpiece are stored in the form of [xO,yO,zO, aO, jSO, y 0]c, 

[xl, yl, zl, a 1, i8 1, y IJc, [x2, y2, z2, a 2, jS 2, y 2]c and [x3, y3, z3, 

3a, jS 3, 7 3]c as the positions and postures of the workpiece W of the 
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camera coordinate system. 

With the above operation, the teaching model and the relative position of 
the camera to the workpiece are stored in the non-volatile memory 37 of the 
image processing device 30. 

Fig. 2 is a schematic view showing the second embodiment according to 
the present invention. The second embodiment is different from the first 
embodiment shown in Fig. 1 in that the camera 20 is fixed in place, and the 
workpiece W serving as the object is grasped with the hand moimted to the end 
of the robot wrist or is fixed to the movable part of the robot for generation and 
storage of the teaching model The robot controller 10 and the image 
processing device 30 in the second embodiment are similar in configuration to 
those in the first embodiment, except for the processii^ for generation of the 
teaching model Fig. 8 shows the flow of the procediire to generate the teaching 
model - 

After calibration of the camera 20 fixed in place, the camera coordinate 
system is set in the robot controller 10 and stored in the memory 2 (Step 200). 
Accordingly, the coordinate transformation matrix of the camera coordinate 
system as seen firom the world coordinate system may be produced. 

Then, the operator sets, in the robot controller 10, the position and 

posture of the robot wrist, as seen firom the center of the flange surfeice of the 

robot wrist in the coordinate system (the work coordinate system) supposed on 

the workpiece grasped with the robot hand (or fixed to the movable part of the 

robot) are measured and the measured data is set in the robot controller 10 and 

stored in the memory 2. As a result, the robot is allowed to recognize the 

position and posture in the coordinate system (the work coordinate system) 

supposed on the workpiece when the robot is at any position. 
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Then, similarly to the first embodiment, the operator sets the first (0*^) 
position and posture of the workpiece W grasped with the robot hand for the 
image-taking operation with the camera 20 fixed in place, together with the 
turning axis and turning angle of the robot to turn the workpiece with respect to 
the camera 20 fixed in place fix)m the first position and posture in order to 
specify the positions and postures for the subsequent image-taking operations 
(Step 202). 

The positions and postures resulting from turning the workpiece grasped 
with the robot hand by 30, 60 and 90 degrees about the axis passing through the 
CEimera 20 and beii^ parallel to the X-axis of the work coordinate system are set 
as the first, second and third positions for the image-taking operation in the 
similar manner to the first embodiment As long as the number N of positions 
for the image-taking operation is set at "4", it is possible to generate the similar 
teaching models to the first embodiment as shown in Fig. 4. 

When a command to generate the teaching model is supplied throi:^h 
the teaching operation panel 4, the processor 1 of the robot controller 10 
initializes the counter M to "0*', operates the robot so that the workpiece W 
moves to the Mth (=0) position and posture and issues a command to take the 
image with the camera 20 to the image processii^ device 30 (Steps 203, 204). 

The image processing device 30 takes the image of the workpiece W with 

the camera in response to the above command and generates the Mth teaching 

model on the basis of the image data produced ftom the image, and stores the 

generated teaching models in the non-volatile memory 37. Further, the image 

processing device 30 calculates the position and posture of the coordinate system 

(the work coordinate system) supposed on the workpiece as the coordinate 

transformation matrix as seen fix>m the camera coordinate system, stores the 
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calculated position and posture in the non-volatile memory 37 as the Mth 
teachii^ model for the relative position and posture of the camera to the 
workpiece and outputs a data acquisition signal to the robot controller (Steps 
204to2G6). 

The processor 1 of tiie robot controller 1 increments the counter M by "1" 
in response to the data acquisition signal (Step 207), and decides whether or not 
the value of the counter M is smaller than the set value N (=4). When the 
value of the counter M is smaller than the set value N, the processing is 
returned to Step 204 to move the robot to the Mth position and posture. 

In the following operation, the processing in Steps 204 to 208 is executed 
for storing the teaching model and the relative position and posture of the 
camera to the workpiece in the non-volatOe memory 37 in the same way as in 
the first embodiment until the value of the coimter M reaches the set value N 

(=4). - 

Fig. 3 is a schematic view showing the third embodiment according to 
the present invention. According to the third embodiment, both the workpiece 
and the camera are respectively fixed to the movable parts of the robots or are 
grasped with the hands thereof for generation of the teaching model The 
robot controllers of robots RBI, RB2 in the third embodiment are substantially 
similar in configuration to that shown in Fig. 5, except tiiat two robot controllers 
are connected together through the communication interfece and that the image 
processing device 30 is connected to only tiie second robot controller. The image 
processing device 30 is also similar in configuration to that shown in Fig. 6. 

The workpiece W serving as the object is grasped with the hand of the 

first robot RBI and the camera 20 is mounted to the wrist of the second robot 

RB2. The position and posture of the second robot RB2 in the world coordinate 
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system as seen firom the world coordinate system of the first robot RBl is 
measured to find the coordinate transformation matrix (A), which is then stored 
in the first robot controller (Step 300). 

Further, the coordinate transformation matrix (B) of the position and 
posture of the coordinate system (the work coordinate system) supposed on the 
workpiece W grasped with the hand of the first robot RBI, as seen fixim the 
center of the flange surfece of the robot wrist, are set and stored in the robot 
controller of the first robot RBI (Step 301). Calibration of the camera 20 
moimted to the wrist of the second robot RB2 is performed and the 
transformation matrix (C) fix)m the center of the fllange surfece of the second 
robot wrist to the camera coordinate system is set and stored in the robot 
controller of the first robot RBI (Step 302). 

Further, like the first and second embodiments, the position and posture 

of each of the first and second robots are set in each of the robot controllers such 

that the camera 20 and the workpiece W of which image the camera 20 first 

takes to assume the first (0^) relative position and posture for the image-taking 

operation. Subsequently, the first, second, . . . and ith positions and postures 

for the image-taking operation are set together with the nimiber N of positions 

and postures for the image-taking operation. According to the third 

embodiment, the relative position and posture of the camera to the workpiece 

are set by turning any one or both of the camera and the workpiece by a 

predetermined tumir^ angle relatively to each other in a manner such that the 

second robot RB2 moimted with the camera is operated to turn the camera 

relatively to the workpiece W without shifting the position and posture of the 

first robot RBI graspii^ the workpiece W fcom the first position and posture, or 

that the first robot RBI is operated to turn the workpiece W while the camera 
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20 is fixed in place without shiftily the position and posture of the second robot 
KB2. 

Further, the turning axis of each of the robots is set to be an axis which is 
orthogonal to the center axis of the camera 20 parallel to an axis of each world 
coordinate system and also passes through the center position (the origin of the 
camera coordinate system or the origin of the work coordinate system) of the 
other party. For instance, in the embodiment shown in Fig. 3, the angles the 
workpiece W or camera 20 turns about Z axis (vertical axis) of each of the world 
coordinate system which passes through the camera 20 or the workpiece W is 
set. For simple setting of the turning axis and turning angle, one of the 
workpiece W and the camera 20 is turned with the other fixed in place. 
However, in the case where the robot operated for turning the workpiece or the 
camera is prevented fix)m moving, the other robot for keeping the camera or the 
workpiece fixed is driven such that- the camera and the workpiece assimie the 
relative position and posture set in advance (Step 303). 

When the command to generate the teaching model is supplied through 
the teaching operation panel 4 any of one of the robot controllers, the processor 1 
of the robot controller 10 of each of the robots RBI, RB2 initializes the counter M 
to "0" operates the robot to move the workpiece W to the Mth (0^) position and 
posture and issues a command to take the image with the camera 20 to the 
image processing device 30 (Steps 304, 305). The image processing device 30 
takes the image of the workpiece W with the camera in response to the above 
command, generates the Mth teaching model on the basis of the image data 
produced fxxym the image and stores the generated teaching model in the non- 
volatile memory 37 (Step 306). 

Further, the position and posture of the coordinate system supposed on 
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the workpiece W is obtained as the coordinate transformation matrix (D) as seen 
from the world coordinate system of the first robot, on the basis of the position 
and posture of the first robot as of the time of image-taking operation and also 
the coordinate transformation matrix (B) set in Step 301. In addition, the 
position and posture as seen fix)m the camera coordinate system is obtained as 
tiie coordinate transformation matrix (E) as seen fix>m the world coordinate 
system of the second robot, on the basis of the position and posture of the second 
robot and also the coordinate transformation matrix (C) set in Step 302 (Step 
307). The position and posture supposed on the workpiece W is transformed 
into the coordinate transformation matrix (F) as seen fi!X)m the camera 
coordinate system through the operation of the following expression (1) on the 
basis of the coordinate transformation matrices (D), (E) foimd as described above 
and also the coordinate transformation matrix (A) set in Step 300, and is stored 
as the Mth relative position and posture, and then the data acquisition signal is 
outputted to both the robot controllers. 

(F) = (Er (A) ' (D) (1) 

The processor 1 of each robot controller 10 increments the counter M by 
"1" in response to the data acquisition signal (Step 308), and decides whether or 
not the value of the coimter M is smaller than the set value N (=4) (Step 309). 
When the value of the coimter M is smaller than tiie set value, the processing is 
returned to Step 305 to move the robot to the Mth position and posture. 

In the following operation, the processing in Steps 305 to 310 is executed 
for storing the teadiing model and the relative position and posture of the 
camera 20 to tiie workpiece W in the non-volatile memory 37 in the same 
manner as in the above first and second embodiments until the value of the 
coimter M reaches tiie set value N. 

21 



m # 

In addition to the above three kinds of embodiments for generation of the 
teaching models, a description will now be given of the application of the 
teaching models to the case of starting a picking job to pick out the individual 
workpiece from the pile of workpieces W, for instance. 

The robot wrist is moimted with the camera together with the hand. 
When a command to pick a workpiece is supplied through the teachir^ 
operation panel or the like to the robot controller 10, the processor 1 starts the 
procedure of the picking job as shown in Fig. 10. 

After operating the robot to move the camera mounted to the wrist of the 
taught robot to the image pickup position where the piled workpieces are in the 
field of vision of the camera, the processor 1 firstly outputs the three- 
dimensional position and posture of the camera on the world coordinate system 
to the image processing device 30 together witti a command to take the image of 
the workpiece (Steps 400, 401). - 

The processor 31 of the image processing device 30 takes the image of the 
pile of workpiece in response to the image pickup command, data obtains the 
image data of several workpieces, and stores in the im^e memory 36 (Step 
402). 

Subsequently, the processor 31 detects a workpiece by performii^ 

pattern matching by using one (the 0*** teaching model) of the teaching models 

stored in the non-volatile memory 37 (Step 403). In the above pattern 

matching, variations in position, turning and scale of the im^e of the 

wortpieces are detected. Then, the processor 31 decides whether or not the 

detected workpiece has a matchir^ value of not less than a reference value (Step 

404). When the workpiece having the matching value of not less than, the 

reference value is not found, the processor 31 further decides whether or not the 
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pattern matching was completed for aU the teaching models (the 0**^ to 3"^ 
teaching models) (Step 405). If not completed yet, the processor 31 makes the 
pattern matdiing of the image data with the other teaching model (Step 406). 

When the image data of the workpiece having the matching value of not 
less than the certain reference value is detected throv^h the pattern matching of 
the image data with any of tihe teaching models in Step 404^ pattern matching of 
the detected image data of the workpiece is carried out with all the other 
teaching models. That is, the processor 31 carries out the pattern matching of 
the detected image data of the worlq)iece with all the stored teaching models 
(Step 407). 

The processor 31 selects the teaching model of the h^hest matching 
value obtained by the above pattern matching to obtain the ultimate relative 
position and posture of the camera to the workpiece on the basis of the relative 
position and posture of the camera -to the workpiece stored in association with 
the selected teaching model and also the amount of variations in position, 
turning and scale within the image in the pattern matdiir^ of the image data 
with respect to the selected teaching model 

Then, the processor 31 finds the position and posture of the workpiece on 

the world coordinate system on the basis of the above ultimate relative position 

arid posture and also the position and posture of the camera in the world 

coordinate system sent through the processing in Step 401 and outputs the 

above found position and posture. That is, since the relative position and posture 

of the workpiece to the camera is the position and posture of the workpiece as 

seen fi:om the camera coordinate system, the position and posture of the 

detected worlq)iece on the work coordinate system may be foimd through 

operation of coordinate transformation on the basis of the data of the above 
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position and posture and also the data of the position and posture of the camera 
in the world coordinate system (Step 409). 

The robot controller 10 actuates the robot on the basis of the transmitted 

mm 

three-dunensional position and posture of the detected workpiece W, picks the 
detected workpiece and move the workpiece to a predetermined taught position 
in the manner similar to the prior art (Step 410). Then, the processing is 
returned to Step 402 to repeat the processing from Step 402. 

When aU the workpieces are picked from the pile of workpieces, a 
matching value of not less than the certain reference value can not be detected 
any more by conducting the pattern matching of the image data with all the 
teaching models in the processing in Steps 403 to 406, so that the picking job is 
finished. 
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